/*
 * Test of one motor: gradually increase the speed of the motor 0 (CON11) and
 * display the ticks from the encoder
 */

#include <string>

# include "camera_reader.h"
# include "image.h"
# include "image_processor.h"
# include "init_systems.h"
# include "jpeg_buffer.h"
# include "printfstring.h"
# include "log.h"
# include <time_tools.h>

# include "basic_processor.h"

# include "camera_task.h"

# include "robo_control.h"

//130.237.226.221

using namespace kthrobot;
using namespace std;
using namespace Group5;

int main (int argc, char **argv) {

  Init::RegisterCommon();
  RRCon::Register();
  if ( !Init::Systems(argc, argv) ) return 1;

  {

  Robo_Control motor1("motor1",0);
  Robo_Control motor2("motor2",3);

  motor1.SetTargetSpeed(2);
  motor2.SetTargetSpeed(-2);
  motor1.Start();
  motor2.Start();

  //TimeTools::WaitSecs(4);

  }

  Init::Shutdown();
  return 0;

}
